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(54) Title: METHOD AND DEVICE FOR SENSING OF OBSTACLES FOR AN AUTONOMOUS DEVICE 

(57) Abstract 

The present invention provides a method and a system 
for proximate field orientation of an autonomous device 
and utilizes a transmitted wave having a first frequency of 
slow propagation, whereby reflections from obstacles within 
a proximate area are detected. According to the present 
invention receiving means are arranged in a slanted plane 
or preferably along a curved base-line to, in a simple way, 
obtain a three-dimensional direction to an obstacle reflecting 
the frequency of slow propagation. Additionally is arranged 
above at least one receiving means an absorber or a screen 
or a combination thereof, whereby that acts as an "eyebrow" 
attenuating undesired reflections which at the receiving means 
come from overhead. Additionally at least one of the 
receiving means along the generally curved base-line is 
arranged differently in height in relation to the remaining 
receivers and preferably the most outer receiver means on 
each side in the line of receivers along the generally curved 
base-line are arranged differently in height in relation to the 
remaining receiving means for an improvement of the three- 
dimensional resolution. 
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METHOD AND DEVICE FOR SENSING OF OBSTACLES 
FOR AN AUTONOMOUS DEVICE. 

Technical fiela 

The present invention refers to autonomous devices, for instance 
in the form of an autonomous and self orientating vacuum cleaner 
and more exactly to a method and a device for its orientation in 
the immediate surroundings by means of a sensing system having a 
transmitter for a wave frequency of a slow propagation and a 
receiving system having a geometry offering an advantageous 
sensing and determination of the position and height of an 
obstacle in the course of the autonomous device. 

Background of the invention 

For many years there has been a desire to provide, for instance, 
an autonomous apparatus for floor treatment, particularly a 
vacuum cleaner, which is controlled by a sensing system sweeping 
around the horizon in analogy, for example, with a ship radar. 
Then the desire is, that the apparatus should be able to 
orientate itself in a room, such that it, for instance, will be 
able to perform a cleaning function according to a predetermined 
pattern or a predetermined strategy and at the same time avoid 
colliding with different obstacles, which may be arranged in the 
room, besides avoiding collisions with the walls of the room. 

The patent document SE 313,409 from 1969 discloses a device for 
an independently operating apparatus for floor treatment, which 
is provided with a pair of wheels driven by an electric motor. 
This device is characterized in that one of the wheels is auto- 
matically releasable against the action of a spring when the 
apparatus meets an obstacle, whereby the pair of wheels may be 
turned around a vertical axis, and the moving direction of the 
apparatus may be changed and additionally the direction of wheel 
rotation may be switched so that the apparatus in principle can 
move and avoid the obstacle. Additionally, the device is guided 
by a controller, which generally guides the travel of the device 
over the surface to be cleaned. 



WO 95/26512 



PCT/SE95/00330 



2 

Also the document SE 364,574 discloses a corresponding device, 
which on its front side is provided with an obstacle detection 
device having sensing means delivering electric signals, and by , 
which the width of obstacles, in the course of the device, may be 
determined. The sensing means operate completely mechanically and 
preferably consist of micro-switches. 

in GB 1,403,860, having priority from an 1972 application, is 
disclosed a process and a device for automatic treatment, e.g., 
cleaning, of a bounded area, whereby the device will move over 
the entire area and automatically changing its course at the area 
boundaries. Anyhow, the device cannot in advance detect other 
obstacles present within the bounded area and follows in 
principle a predetermined program to cover all the surface of the 
bounded area. 

Another such apparatus system is further disclosed in the 
document CH 619,799 from 1973, having priority in an application 
DE 2,360,002 from 1973. This apparatus, which is driven by two 
wheels, is arranged with an electro-optical measuring device, 
which displays several beam inputs and outputs. The measuring 
device serves to measure the distances between the apparatus and 
measuring points on the walls limiting the room. The measured 
points are entered into a coordinate calculation processor, which 
calculates, correlates and controls, respectively, the coordi- 
nates of the measuring points and stores these calculated values 
in an orientation memory. By means of a path counter connected to 
the wheels the motion of the apparatus is additionally calculated 
and the apparatus is guided by means of this information to by 
itself systematically travel over the entire surface of the floor 
for cleaning that surface. 

A drawback here is the difficulty to locate obstacles which may 
be present in the course of the apparatus in its travels over the 
floor as an electro-optical sensing system which, due to the high 
propagation speed, demands a measuring system capable of 
measuring very short time periods, why, first of all, such a 
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system, even still with the recent development taken place within 
electronics and computer technique, will be so expensive that it 
above all from the point of prioe level cannot be made available 
to thei public. Thus, it is still technically seen difficult with 
such an electro-optical method to measure short distances with a 
satisfactory resolution. Additionally, if an obstacle exhibits a 
smooth angled surface, such an electro-optical sensing pulse may 
well be reflected in such a direction, that the reflected signal 
never will be apprehended by the receiver 4 and thereby no 
indication of the obstacle will be obtained, why the apparatus 
will soon collide with such an obstacle in its travel. 

In an document from 1984 by James L. Crowley having the title 
"Position Estimation for Intelligent Mobile Robot", The Laborato- 
ry for Household Robotics, Carnegie-Mellon University, a solution 
of the problem to maintain an estimate of the position of the 
robot, when it travels in either a known or unknown environment, 
is further described. The document additionally gives a number of 
further references to different algorithms used for modelling in 
this context and which may be used to program a dataprocessor for 
the guiding of such a robot. An apparatus demonstrated in the 
document utilizes in part encoders at the robot's wheels to 
determine its travel and in part a rotating sensor sensing the 
distance to exterior surfaces having a beam with a starting 
diameter of approximately 7.5 cm and a beam spread of about 3°. 
The sensor rotates at about 1 revolution per 5 seconds and 
returns the distance to the nearest surface within 6 m to a 
resolution of 3 cm. The apparatus may then be placed into a 
learning mode during a guided tour of the world where it is 
supposed to act. Starting from the learn mode the apparatus will 
then from some starting point by itself orientate in this now 
explored environment. 

In U.S. Patent No. 4,674,048 having priority from JP 200360/83 is 
disclosed a guiding system for a moving robot, which calculates 
its momentary position and sequentially stores data of the 
obtained positions and which information then is used for the 
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.1 of the robot. The robot then calculates a 
continuing travel of the rouo ±x is allowed to 

«avel pattern within a specified area whereby Ued 
travel within the range without . leaving any region 
ana taKin, notice or possible ° B -~^trrors -e to 
course. Besides the rohot compensates ^°"" lon of its 
slippage of its drive wheels or errors in the oper.t 



motors . 



Ther e are additionally a meltl^de of -J- document - ~ 

automatically guided autonomous machines. 

•,0B7 o s Patent No. 4,638,445 discloses 
Another document from 1987, U.S. ""ten „„, 1o »s et least two 
a vision system for , mobile rohot which employs st^ 
arrays of sensors for obtaining data on the ^position an ^ 
„ objects in a workspace. One sensor «»» is used 

aaed principally to see near ejects other^ 
principally to see far objects. Tne sensors . The system 

transducers which then operate as ^ ^ ^ahle 

sK etched demands a fairly large - particularly a 

for an autonomous apparatus for floor treatmen 

vacuum cleaner. 

Fina lly a recent document U.S. Patent ^J^J^ZZ 
discloses a navigational control system to direct a q 
vehicle to travel along a floor from a le ast 
destination within an environment The vehicle reUe 
one reflective encoded stripe applied ito J*e * * via a 

tion also relies on a separately ^^° S ^J SOI in the 
wireless link, which together with a local pr 
vehicle guides the vehicle. 

. »ll these previous designs is that those because of the 
Common to all these previ needed for their 

„ differently combined methods neeaea 

multitude of differently ^ and 

orientation and steering most often will b produ ce. 
above all they are utterly complicated and expensive P 



WO 95/26512 



PCT/SE95/00330 



5 

Therefore there is a desire to provide a method which may be 
applied in a system of an autonomous device, which by way of this 
method still will be possible to manufacture at reasonable 
production costs, such that a ready-made product, for instance, 
for automatic vacuum cleaning of a room will be provided at a 
total price, which makes the product available to the public. 

Summary of the invention 

According to the present invention a proximity sensing method and 
system is provided for an autonomous device, the device compris- 
ing a microprocessor system and a sensing system having transmit- 
ter means and receiver means utilizing a transmitted wave of 
relatively slow propagation, whereby reflections within a 
proximity area are detected by means of a particular receiver 
system, being interfaced to the microprocessor for the frequency 
of said wave of slow propagation. 

According to a first object of the present invention the 
receiving means are positioned in a line along a curved base-line 
to in a simple way obtain a three-dimensional direction to an 
obstacle which reflects the wave of slow propagation. 

According to a second object of the present invention an 
absorbing means or a reflector or a combination of those is 
arranged above at least one receiving means, whereby this acts as 
an "eyebrow" which at the receiving means attenuates the 
reception of reflections from undesired directions. 

According to a third object of the present invention one of the 
receiving means along the generally curved base-line is additio- 
nally positioned differently in height compared to the rest of 
the receiving means and preferably the most outward receiving 
means on each side in the row of receiving means along the 
generally curved base-line are positioned differently in height 
in relation to the remaining receiving means. 

According to an additional object of the present invention the 
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„ave for sensing obstacles P—ate - ~ ^ Iff re^ncy 
regularXy transmitted swept (chirped, signal on < 



range ) . 



AO eording to an additional ob 3 ect of the present mention - 
receiving means along the curved base-line comprise. , *>P 
aerophone members adapted to this -eve frequency and arranged * 
^roduL a suitable digital signal to the microprocessor 
autonomous device. 

Bescrletlgp ~* + ho drawings 

Th e invention will be described in form of a preferred embodiment 
by making reference to the accompanying drawings, in which. 

Fig . x demonstrates a side vie- of an autonomous device in . 

embodiment es a vacuum cleaning robot according to the 

present invention; 
Fl9 . 2 demonstrates a plan view of the vacuum cleaning robot of 



Fig. 1; 



Fla . 3 demonstrates an elevated cross section view of the 
vacuum cleaning robot of Fig. 1> 

Fig . 4 shows a room provided with a number of active bacons or 
transponders and where the vacuum cleaning robot of Fig. 
X has to orientate by means of s first encircling along 
the walls of the room; 

Fig . 5 shows the way the vacuum cleaning robot ending to 
Fig. 1 in principle will do its cleaning action after 
having explored the room; 



WO 95/26512 



PCI7SE95/00330 



7 

Fig. 6 demonstrates a generally basic picture for estimation of 
the position of a transponder by means of a built-in 
sensing function; 

Fig. 7 shows in part estimation of the position of a trans- 
ponder by means of an hypothesis method and in part by 
means of a geometric path estimation; 

Fig. 8 shows orientation towards a transponder during a first 
encircling of the room; 

Fig. 9 demonstrates a sensing principle having a separate 
transmitter and receiver and different propagation times* 
between transmitter and a target and between the target 
and the receiver; 

Fig. 10 shows geometrically a relation between a transmitter a 
number of receivers according to a preferred embodiment 
of the present invention; 

Fig. 11 shows a typically received signal, a floating threshold 
and a signal detected by one of the microphones; 

Fig. 12 demonstrates in an illustrative embodiment a division of 
viewing areas of the robot, the front area concerning 
the rectangle in the forward direction and the side 
areas concerning the rectangles positioned an the right 
and left side of the robot; 

Fig. 13 demonstrates the way of performing calculation of the 
distance from a point to all of the microphone elements, 
whereby the number of microphones being used is depen- 
dent on decisions taken by the navigational function, 
and 

Fig. 14 demonstrates the geometry to calculate compensation of 
the height difference between the transmitter member and 
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An 



j^lustratlve fireferrea embodiment 



n-^or^ description lane top 

In rig. X, in a right side view, and in Fig^ 2 i * 
view, is disclosed an illustrative o£ the 

vacuum cleaner 10. which applies.the » iple 

present invention. The vacuum cleaner 1 >°°™* 1 ™? » ^ 13 . 
. circuler housing 11 provided with two driven 1 
On the housing 11 there is a control panel 15 provi 
TOnt rols and indications for ^ devi- e— » » ^ 
«. art. as well es^ - » li£ied plcture aOT o„str.t- 

unit 14 of the devrce. Fig. 3. in " ^ the 

r^-F -the vacuum cleaner iu, 
ing a cross section of the ™~ apartments, a back 

housing 11 in principle comprises 3 P 
compartment 17 for collection of dust above theva 

4* 14 a central compartment 18 for instance to 
unit 14, a cenr batt erv and driving motors, and a 

components like accumulator battery a exa m P le a 

4. m0 rvr- 19 for the remaining equipment, for exauy 
front compartment 19 for rn circu it boards and 

preprocessor and associated pr inted circu ^ 

electronics for the transmitter and «^J^ its ope ration. 

. , t he vacuum cleaner during ^ 

an d for the guidance of the va ^ adQitionally at its 

As is also seen in Fig. 3 the ^ & mechanical 

forward edge, in a common manner, i pr ^ 

sensor 21 for the case it should collide . wit 

aetected in a— In --^^1 sensor heing 

up. e.g.. when the vacuum „ 
corresponding, up on the top of a number of 

ult rasonic transmitter » which. q£ obstaoles ln 

ultrasonic microphones, is "^edfor „ ^^ent 

^e course of the "TV^.^ having e dieter of 
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and on top is provided with a sound absorbing plate on which then 
additionally is placed an IR receiver. Thus, in this embodiment 
the housing 11, the ultrasonic transmitter 20 and the mechanical 
sensing 21 constitute ah integrated unit. 

In Figs. 4 and 5 the principle is demonstrated of. the way the 
vacuum cleaner performs an automatic cleaning of a room. In the 
room of the example shown there is, for instance, a sofa 30 and 
the room is further in this case provided with four transponders 
31 - 34 for the orientation of the vacuum cleaner. In this 
example all of the transponders are within the area to be 
cleaned, but it should be noted that a transponder very well may 
be positioned out of the bounded cleaning area. When the vacuum 
cleaner is to perform an automatic cleaning of the room it starts 
in a traditional way to at first make one full round around the 
room with wall tracking, along the walls limiting the room, 
starting from transponder 31 or "beacon 0". The wall being 
tracked during a wall tracking is all the time registered by 
means of the ultrasonic device, and will thus all the time be 
present on the left side of the apparatus when the apparatus is 
making a right hand round. Additionally the transponders 31 - 34 
are registered by means of a system in which the transponders are 
active and respond when the transponders have registered a 
transmitted ultrasonic pulse from the apparatus. In the illustra- 
tive embodiment such a sound pulse, alternatively a swept pulse 
(chirp pulse) is transmitted every hundred milliseconds during 
that the apparatus at the same time is moving along the wall. It 
should be noted that in an embodiment using a chirp signal it is 
of course possible to lengthen that such that an altogether 
continuous signal is generated instead of distinct pulses. The 
same ultrasonic transmitter, in practice in the illustrative 
embodiment, is used both for the proximity orientation and for 
the communication with the transponders. By means of the 
responses from the transponders and the motion along the wall the 
microprocessor then builds up a kind of an image of the room, 
where the exact positions of the transponders will be better and 
better determined the longer the apparatus is travelling during 
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15 



20 



25 



30 



this orientation round, and at the seme time it Is pe 

cleaning function along the path covered. During this round^the 

sofa 30 in the demonstrated example .111 also be 

the ultrasonic device and will be placed into the map of the 

r oom generated. This map is successively further filled in when 

the room is vacuum cleaned. 

After one turn around the room has been completed the vacuum 
c leaner is prepared to by it self perform its automatic cleenl^ 
of the remaining surface of the room, which is illustrate .in 
Fig. 5. The microprocessor then calculates e motion pattern such 
that the entire surface will be covered by the apparatus .end at 
the same time with a suitable sm^l overlapping. During I this 
operation function the device now will utilise the -map ^ 
.nd verify the travel of the apparatus by comparisons with the 
positions of the transponders end by means of cover* 1 path 
registered by the wheels. By separate driving motors of Jhe 
wheels 12 and 13 and their position the apparatus may ******* 
he rotated around its symmetry point, which then is the orlglnof 
the circle constituting the limiting line of the housing 11. The 
driving motors in an illustrative embodiment are for 
motors having the designation KH56HM2-S01 from «pan Servo Co 



LTD. 



35 



Simultaneously as the apparatus is moving the ultrasonic ^ system 
performs a proximity area sensing within a range 0-40 - « 
detect possible obstacles, which by some reason are not noted in 
the previously generated mapping image and which are ™t possible 
to be driven over by the apparatus. Due to the low height of the 
apparatus is can for instance also vacuum clem underneath a 
Tie or a chair, whereby it only has to avoid their legs. «hen 
the apparatus has registered an obstacle it first turns around 
end continues the surface cleaning of all open surfaces 
Thereafter cleaning is performed around obstacles b^ for 
instance, making a full turn around the obstacle if thrsi. 
possible, before it continues to the ne,t obstacle After 
Lpleted cleaning the robot returns to the starting position for 
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charging . 

Thus with this generally described system a vacuum cleaner or 
n dust robot" is obtained, which by itself with a starting 
position from a point in a room automatically is capable of 
performing a vacuum cleaning of the room after it received a 
command for this. In the illustrative embodiment the "beacon 0" 
constitutes a docking point for the device, where it normally is 
in idle and may then recharge its built-in accumulator and where 
it may return for additional charging if the apparatus from a 
previous charging of the accumulator is unable to complete a 
vacuum cleaning of the entire room. The transponders 31 - 34 
additionally are, in this case, of an active type, which has an 
own power supply, either by means of a battery or by for example 
being connected to available power outlets, which in the 
described embodiment is applicable for the docking transponder 31 
to obtain charging current for the accumulator. In Figs. 4, 5, 6 
and 8 the transponder 34 is typically self supporting by means of 
a battery, while transponders 32 and 33 like the docking 
transponder 31 are connected to available power outlets. The 
transponders 32 and 33 remind in appearance of small lamp devices 
which sometimes are inserted into power outlets to in dark 
generate guiding light. Thus, in principle , regarding the height 
above floor, the transponders may be placed freely and the only 
one which by necessity must be present on a wall and at the floor 
will be the starting and docking transponder 31. Anyhow, 
according to the preferred embodiment the height of a transponder 
is for instance limited to 1 m above the floor to be able to 
reduce radiation upwards from the ultrasonic transmitter and 
thereby reducing the number of unwanted reflections from above 
which contribute to the general noise background. 

Here as an illustrative embodiment a vacuum cleaner has been 
described, but the invention is of course applicable to any 
autonomous robot, for instance, for any other kind of cleaning 
function, e.g., like floor polishing. 



WO 95/26512 



PCT/SE95/00330 



12 

Short gk§S£iB £ £ orientation function 

Por the orientation function an. orientation device POM iPQsition : 
Manager) is used; which additionally comprises a number of 
s Routines for the microprocessor of the device to in ^ g.ide 
the robot each 20th milliseconds and in part for positioning. At 
Z start of a wall tracking the position of all the ™nders 
is unknown except for transponder 31, i.e., the "beacon 0 which 
is used as starting point for the orientation and thus constx 
tutes origin in its own coordinate system. In Fig. 6 is shown a 
starting position where a sound pulse is registered by "beacon 
3" i.e., transponder 34. The time, e.g., for an ultrasonic pulse 
to' propagate from an ultrasonic transmitter 20 of the . vacuum 
cleaner 10 to the transponder 34 gives a measure of the distance 
to the transponder. The transponder in turn ^^^l^ 
has detected the ultrasonic pulse by means of transmitting back 
on another frequency, e.g., a light pulse or a 
to a receiver on the vacuum cleaner. The time for this electro 
magnetic wave to propagate back is comparatively negligible and 
deduced from the time period from that the pulse was ^smitted 
until it was detected by the transponder the distance d, to the 
transponder is achieved. It is then obvious that the ^nsponder 
is situated somewhere along a circle having its origin at the 
transmitter 20 and a radius equal to d x . 

Now one method of positioning the transponder is by means ^of the 
hypothesis method. The hypothesis method, which xs sketched in 
Fig. 7, means that for each transponder try a number of for 
instance, 4 parallel Kalman filters. (A complete description of 
the Kalman equations may for example be found in A. Gelb Applied 
Optimal Estimation", MIT Press, 1975 and H. Sorenson Kalman 
Altering: Theory an Application", IEEE Press, 1985). Also other 
types of filters may of course be applioable. Thus thxs 
corresponds, in Fig. 7, to four different hypotheses, of which 
one gradually will be chosen. When the transponder distance d, 
achieved the initial position of the transponder in the respec- 
tive filter are assigned (x^+d^ yrebot ), Ow* Y^fA ) , (*«*..' 
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yrobot" d i) and ( x robot-^i. Yrobot ) • If n ° filter converged all hypothe- 
ses are rejected and the method is repeated. After finding a 
H best estimate" this value may be used in a new calculation set, 
where all' collected values are again used, but in reversed order. 
The result then obtained has a higher accuracy than the first one 
obtained. 

Another method of positioning the transponder may be performed by 
geometrical path determination. .Even this method is sketched in 
Fig. 7 as well as in Fig. 8 and works like that the robot has 
travelled so far that two "legs" Sj and s 2 may be generated which 
together with the transponder distances d x , d 2 and d 3 form the 
basis for a trigonometric calculation of the transponder 
position. The course determination then preferably forms initial 
value to the Kalman filter. To obtain a sufficient accuracy the 
method demands that s z and s 2 are of enough length and intersect 
with a certain minimum angle. The method is in part prolix, as 
all measured transponder distances between positions 1 and 2 must 
be stored (they will be filtered afterwards when the initial 
value finally has been determined). Besides certain geometries 
combined with an unfavorable furnishing may imply that the 
transponder only is visible occasionally, which may signify that 
two "legs" are never generated. 

A positioning of one transponder 34 is illustrated in Fig. 6, 
whereby a sequence must be run through for each transponder being 
detected. The principal elements of such a sequence is, for 
example, as below: 

a) The robot moves from the transponder 31 and obtains the 
distance to the transponder 34. The first measurement d x 
is obtained at sample 1. 

b) Now a filter program in the microprocessor is started, 
in the Figure with four Kalman filters (in the illustra- 
tive embodiment in reality 12). The initial position of 
each filter is uniformly distributed on a circle of 
radius d x . 
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c) • Eech new sample is input to respective filter. ^ In the 

Figure 4 filters ere operated in parallel with the seme 
data (samples 1, 2, 3,. ...)• . . J 

d) • samples i, 2, 3/ ..: (the transponder distances! are 

stored together with the robot position. Those will be 
used later for a repeated filtering of the best hypothe- 
sis 

e) The' filtering, goes on until a filter in part has built 
up (reached a given accuracy) and in part has converged, 
i.e., that the residue of the difference between the 
expected and measured transponder distance falls below 
a given value- 

£) The result of the best hypothesis is checked «*-rd±»a 

likelihood. Thereafter a refiltering takes place with 
the output data of the best hypothesis as initial value 
of the transponder, which gives a better accuracy. 
Finally the transponder position is transferred to the 
navigational portion (for example in form of a map 
image) and is used for positioning of the robot. 

When the robot completed one full turn around the room the 
When rne rooov *> m,,<=trative embodiment are 

positions of all transponders in the illustrative ^ 
to a good accuracy put into a "map image" which is ^^J^ 
walls of the room, and are also put in possible o^er obstacles 
which the ultrasonic system for the proximity range did discover 
during this go-around. After this the robot start its cleaning 
function by in its map image follow a calculated pattern to cover 
the entire surface of the room. 

This motion pettem follows e path which is 3-erat««hy. course 
g eneretin g eooule end is aiviaea into a nu^r o se^ These 
segments are either straight lines or arcs, m p 
three coordinate systems are used: 

. one fixed room coordinate system which covers the room and 
with its origin at the first reference transponder, 
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• one vehicle fixed coordinate system with its origin at the 
vehicle reference point, i.e. preferably in its center, and 

; • one segment fixed coordinate system, which gives the position 
of the segment driven in the room. 

All calculations are implemented in the illustrative embodiment 
using integer arithmetics, whereby scaling is applied according 
to the table below. By "scaling" is meant the value of the least 
significant bit, while "length of word" means the number of bits 
used to represent the quantity. 



Quantity Scaling Length of word 
Distance 1 mm 16 

Angle 90°/1024 16 
Position 1 mm 16 

Time 1 ms 32 

In a preferred embodiment of the method and system of the present 
invention is consequently used the same ultrasonic pulse for 
sensing of a proximate area in front of the robot by means of a 
number of receiving means being distributed on the forward case 
of the vacuum cleaner 10 for receiving the reflected ultra sound. 
Each such receiving means then operates within a time slot, 
which, for instance, after transmission of the ultrasonic pulse 
corresponds to an immediate proximate area and serves to discover 
additional obstacles, which were not discovered during the first 
exploring round around the room. Additionally at least one of 
these receiving means is used to control the vicinity of the wall 
at the left side in the first exploring right hand round. When 
the ultrasonic radar has discovered an obstacle, for which there 
is a danger of hitting, for instance, the robot of the illustra- 
tive embodiment decreases its velocity from 0.4 m/s to, for 
example, 0.1 m/s. At this velocity the mechanical sensor 21 may 
hit the obstacle and -there will still be time to stop the robot 
within the resilient distance of the mechanical sensor. 
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The proximity sensing system » ^ ^ ^ 

e-x.di.~ent Is built up as . an ultrason ic _ 

transiting »e»ber and 5 receiving M ans in the Jo™ = 

phone elements. In other uords the present „ lth 

coherent hi-stetio radar, contrary to ^^J^. «. 
^axsieuxteneous^nosta^onon^here^aen^^ ^ ^ 

.ieroprocessor deternanes the tl» fox _ ^ signal 

ultrasonic pulse. The pulse length is „ one or 

Mn u PYrit es the transmitting memoes 

processor. «*• . —It- t pulse (ohlrp 

possible targets should be calculated end reported. 

Ih e microphone signels ere each « 
ceplltude demodulation oi the reeved ^ the 

samples per channel is limited to nrot>a aation path of 

time period of 5 milliseconds or an acoustic propagatio 
170 cm if the sound velocity is assigned 340 m/s. 

section of each microphone signal is done >~^££Z 
of a section — — ^ ^JJ H \ ia . 

fM + T2 from a transmitting element w . o 

^~ion Point ». which thus corresponds to «. P^a a - 

— Ti ~t i^sr^. « - — - 

the transmitter S to the ret reflection point Rl to the 

tion time of the signal from the refl 

receiver M. This propagation , ^°^J t ^ d ^ rec eiver 
eguivalent to an ellipse having the target on 

in the respective focal points of the ell P ^ ^ 

the ellipse in relation to the position of a tr p m 

v!o 6 With different locations of rne rw- 
analogy with Fig. b. wixn intersect each other 

different such ellipses are obtained, which interse 

in the point Rl. 
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To establish a direction (x, y, z) to a detectable object several 
microphones are utilized. In Fig. 10 is demonstrated, for the 
illustrative embodiment , a suitable geometry for the location of 
the transmitting element and the microphone elements onto the 
mobile vehicle, in part in a top view and in part in an elevated 
side view. The coordinate system of the figure is the one 
utilized for the calculation of target positions. The target 
position is given to the navigational function with an x and y 
coordinate. Totally 200 targets may be reported. 

The algorithm for target detection implies that rising flank is 
detected in the received signal. One sample is compared to a 
signal level which is created by a floating threshold and a fixed 
marginal. If the sample exceeds this detection level a detection 
is made and the sample is set to 1, otherwise to 0. The floating 
threshold is a low pass filtering of the signal. 

Fig. 11 demonstrates an example of the appearance the received 
signal may have for one channel. Except the received level, drawn 
by a solid line, the Figure also shows, by means of a dotted 
line, the created threshold level. Detections are marked with a 
dashed line. The first detection originates from a direct path 
from the transmitting element to the microphone element and the 
second originates from a target reflection. The reason for a 
floating threshold is the desire to avoid detecting ringing 
present in the pulse. In addition this setting of a threshold 
implies that differences in amplitude levels between channels 
lack importance as long as the variation of the amplitude versus 
time is behaving in a similar manner. 

When a sample is detected also the previous sample is set to 
"one". In Fig. 11, for example, if a detection is made at sample 
63, then samples 62 and 63 are set to "one". In this way a 
detection corresponds to two samples which make positioning more 
robust. When a target echo finally has been detected the solid 
signal level shown in Fig. 11 must drop below the dotted 
threshold level before additional detections are permitted. 
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"ones" and 



. . ^ "ones ana 

After the detection the signs! vectors ^ consist o^ ^ 
..eros". whereby "ones- correspond « f corresp ona S . 

correspond to a time. This time, according to Fig. ^ ^ 
to a position lying on en ellipse having the 
the receiver M in the respective focal pornts of the 

By calculating intersections between ^™J™^ j£ 
cUis the position of e target .ay he '"^^J^ ln . 
celculetlcn is demanding. The positioning ^L^ZT^ it 
.ore simple way. The demand on the ^^J^^ o£ end 

TZttZ^ZZTZZZ* indicated by 

limits in the x and y directions. 

ln Figs. 1,. and «, are shown an area a---^ 

tive preferred smbodiment comprising one ^ . 

and one right side erea. Each such aree is then di 

^.red point screen of possible terser posrtrons. ° 

doe the distence between these points are grve^ The~ 

of the screen is erbitrery chosen the ease in t* mm- Y „ 

tions. m .11 the points a decision rs taHen whethe 

tar g .t cists, in the « -~ - ~ e ™iso stretched 

* f oor constants in Pig 1 «. the side are ^ of 

by four constants in Fig. 12b. To oem o£ 

the algorithm Fig. 13 demonstrates one of the screen 

Fig. 12a. 

Fig . „ shows the appeerance of tb^ec-try as seen fro. above. 

for instence. for the screen point »3, y 

— Sir^l^rt emoted. For 

7ZZZX rT^' waves fro. two -^^^ 
Th e position of the seiected point "^^^sred. 
Fig. 13. that the distence Es to the transmitter 
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The positions of the microphones are also known and given into 
the program code as constants, which implies that Rl to R5 may be 
calculated if this is desired. By . adding Rs to R1-R5 five 
distances are obtained. 

To obtain the correct sample number the distance must be 
compensated due to difference in height between transmitter and 
receiver, whereby Fig. 14 demonstrates one example of geometry. 

The real propagation path R» is given by the formula 

R 

R f - 

h 

cos(arctan(-) ) 
R 

where R* is the real propagation path including height compensa- 
tion, h is the height between the transmitter element and the 
microphone element and R is equal to Rs+Rm and m = 1, 2, 3, 4, 5. 

The expression above is in the implementation approximated by a 
polynomial of the second order according to established tech- 
nique, one for each channel. Each distance corresponds to a 
sample number in one of the signal vectors stored after detec- 
tion. The propagation path is converted into a sample number for 
the actual microphone by the formula 

R' 

N. « - f . 

v 

where N. is the sample number, R f the geometrical distance, v the 
sound velocity and f. the sampling frequency. 

Also compensation must be included for the delays in the receiver 
channels: N = N. + N d , where N is the real sample, N. the is cal- 
culated sample number and N d is the measured delay. 

As a condition, whether or not the cell contains a target, is 
stated how many of the observed channels which have to contain a 
detection just for the sample corresponding to the cell contem- 
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Plated . «. — - jrrs 111:1::: s z 

example . is selectable between 1 and 5 an 
navigational function. 

_ . he next calculation point if the 
The algorithm goes on to the ^ ^ ^ fQund that 

condition is met (target detected) dete cted). 
the condition is not been investigated in the 

Aft er that the forward direction has b ^ 
example with maximum 5 microphones, the 
using maximum 3 microphones. 

mW as ab ove the symmetry being 
For calculation of sample number - ■ is utilize d. It is 

present between the right and left half P ^ as 

Efficient to calculate sample number o-he^ ^ ^ ^ 
the right half plane will give the 
corresponding cell and microphone. 

the targ « pos^on. „ - - «~ ' " ~ 

navigational function. 

aata » nu^er of » *~ ^processor - - 

^ 9 r =vrrr» - - — - - — 

algorithm should start operating: 

. MiC rophone positions in relation to the ^ZZs^^ 
supposed to sit at the origin ( C 0, J ^ ^ ^ 
origin of the robot). The z polynomial in the 

positions are implemented as a correctxo 
calculation of sample number. 

. Which area is contemplated. 

. Resolution of the contemplated area. 

. Measured time delay. 

. conversion of distance - sample. 
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Measured data: 

• Sample vector from available channels (for instance 5). 

The following parameters are controlled from the navigational 
function: 

• Number of microphones used in the proximity sensing of the 
forward direction (in the example maximum 5). 

• Demand for lowest number of channels which have to contain 
detection for the current cell in the forward direction. 

• Marginal for detection. 

• Number of microphones used for proximity sensing of the side 
area. 

• Demand for lowest number of channels which have to contain 
detection for the current cell in the side area. 

The following output data will be obtained: 

• Target position in coordinates x, y and z. Maximum 200 targets 
may be reported from one pulse sweep (Limited by the perfor- 
mance of the signal processor). Transfer takes place after 
initialization from the navigational function. 

In accordance to the invention by preferably placing the micro- 
phones in a slanted plane or along a suitably curved base-line 
also an information of the height of the target is obtained by 
comparison of the propagation paths, as the paths measured from 
all the microphones indicating echo from the target concerned 
must agree with the estimated position of the target. The curved 
base-line of the illustrative embodiment is determined in a 
natural way by the circular form of the robot. Of course this 
surface containing the microphones may at the same time even be 
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* i rv^d Thus by introducing a height for the target and 

rrich aU Jasured distances at each *^^ g £ 
Microphone agree, whereby, except the distance to the t t 
thus is also obtained an idea whether ^^Zl^on 
ab ove the surface traversed by the robot. means 
is further proved by placing - ^ ~ 7*2S- — 
differently in height relative to the rest In . ***** 



3, and 4. 



, illustrative embodiment the proximity sensing device 

fj? J^T-ii- — ,00- of e forward directed circular 
- a radius ,0 cm. ehich ^^^^ 

an n signal, why the processor system may ^ 

— ^r^r"— — 

Zatrr^Ponder. start to emerg. 
the responses of the transponders f 11 *^,^ . 
£ or that signal frequency hereon « - « -"^ lder . The 
transmitted sound pulse being detected » e^ieent 
r eceiver meens for this response in the t 20 

is placed on top of the ultrasonic reder «.nsmltt« m*- 
(Pig. 1,. The resolution of proximity sensing ~ do 

object by means of the algorithms used for the ultre soun 
have the objective of being better than 5 mm- 

of receiving means, whereby the absorber or screen 
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undesired reflections from above and/or from the side and 
operates as an eyebrow over the receiving means. This absorber or 
screen in an illustrative embodiment is simply a small plate 
placed over the receiving means to limit its sight upwardly. 
Whether this plate operates as an absorber or a screen will be a 
function primarily of the material out of which the plate is 
manufactured. This device is essential for example when the robot 
passes underneath a furniture, the height of which exactly 
permitting the robot to pass underneath the furniture, whereby 
echoes will occur within the direct close neighborhood of the 
robot, and which echoes otherwise then would be difficult to 
exactly position. According to what already has been mentioned, 
the robot decreases its velocity, when it discovers objects which 
may signify risk of collision. In this case it is not absolutely 
necessary to perform a velocity decrease in spite of echoes being 
present within the critical range. Due to the receiver provided 
with an eyebrow will give another echo appearance, the processor 
than will be able to decide that the echoes are coming from a 
surface above the robot, as the normal height resolution operates 
primarily for echoes coming within a sector in front of the 
robot. 

To further improve the proximity sensing, its receiver means are 
provided with a signal attenuating possibility, for instance -20 
dB, which is switched in when echoes from proximately positioned 
targets become so strong that the receiving means run the risk of 
being saturated. 

It will be understood by those skilled in the art that various 
modifications and changes may be made to the present invention 
without departure from the spirit and scope thereof, which is 
defined by the appended claims. 
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CLAIMS 

X. A proximity sensing methoa for an autonomous aevi«><l£ .. 
proviL with wheels ana a motor, besiaes having means to carry 
out some specific function, saia aavice ccmprises mean, for «- 
proximity orientation ana guiaing o£ the aevice in the tor- of. 
C« system ana a proximity sensing system comprising 
.t least a transmitting meens ena e receiving means, character 

"l^ a wave having a sic„ propagation is transmittea from the 
transmitting means of the sensing system, whereby W--^ 
sa ia microprocessor system. ^JJ^^, tLeTor 
corresponaing to a certain proximate erea. «» 
receiving means suitably proviaea with signal Interfaces to 
P roviae saia microprocessor with aigital signals. -'1-"°- - 
ae^ectea from saia wave of slow propegaticn ana thus formrng 
coherent bi-static system; within a 

that said wave of slow propagation is ^^^^ 

tlon basis within the proximity erea to continuously £ ut 

in the eaaitional automatic motions * ses J 

guiaance from aigital processing of the ™ P 

this .eve frequency within the preaeterminea time slot. 

2 The methoa accoraing to claim 1. charecterixea in 

" that aaaitionally at least ^""^ZTZZZ 

3. «. methoa accoraing to els, - ^^c^ber obove 
•that said autonomous device is proviueu 

tnat saw « , ± of receiving means to 

at least one receiving means in the line or r 
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attenuate undesired reflections from above and/or from the side, 
said absorber acting as an eyebrow above the receiving means. 

4. The method according to claim I, 2, of 3, characterized in 
that said autonomous device is provided with a screen above 

at least one receiving means in the line of receiving means to 
attenuate undesired reflections from above and/or from the side, 
said screen acting as an eyebrow above the receiving means. 

5. The method according to any one of the preceding claims, char- 
acterized in that said wave of slow propagation comprises 

a longitudinal acoustic wave. 

6. The method according to any one of the preceding claims, char- 
acterized in that said wave of slow propagation comprises 

an acoustic wave having a frequency within the ultrasonic range. 

7. The method according to any one of the preceding claims, char- 
acterized in that said wave of slow propagation being transmit- 
ted for sensing obstacles proximate to said device comprises a 
short, regularly repeated pulse or alternatively a repeated swept 
pulse (chirp signal). 

8. The method according to any one of the preceding claims, char- 
acterized in that the most outer receiving means on each side of 
the line of said receiving means are arranged differently in 
height in relation to the remaining receiving means of the 
receiving system. 

9. The method according to any one of the preceding claims, char- 
acterized in that said receiving means comprise microphone 
elements adopted to the frequency of the wave of slow propaga- 
tion. 

10. A proximity sensing system for an autonomous device being 
provided with wheels and motor, besides means for carrying out 
some specific function said device comprises means for the 
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prcsimity erientation and guiding of the □.vice in , th. 

Lroprocesser system and a proximity sensing system 

at least a transmitting means and a. receiving means, character ,. 

ized in . Q e iriw 

that said transmitting means transmits a wave having a slow 
propagation, said microprocessor system, during a predetermined 
time slot corresponding to a certain proximity area, via the 
receiving means of the receiver system, which means are suitably 
provided with signal interfaces to provide said microprocessor 
with digital signals, from different obstacles registers 
reflections of said wave having a slow propagation and thus 

forming a coherent bi-static system; 

that said transmitting means transmits this wave of slow 

propagation within a continuous sector into a normal travel 

direction of the device; 

that said receiving means of the receiver system are arranged 

in a slanted plane or preferably along a curved base-line for 

obtaining direction resolution to an obstacle having reflected 

said wave of slow propagation; *<„<<. m i 
whereby by means of said microprocessor system, by digital 
processing of the reflected responses within the P-^rmined 
time slot, creates an orientation basis within the P-x^area 
to continuously via said microprocessor guide said device for 
avoiding obstacles in automated motions. 

11 The system according to claim 10, characterized in 

that additionally at least some of said receiving means being 
arranged differently in height in relation to the remaining 
receiving means for improving the three-dimensional resolution. 

12 The system according to claim 10 or 11, characterized in 
'that said autonomous device is provided with an absorber above 

at least one receiving means in the line of receiving means, said 
absorber attenuating undesired reflections from above and/or from 
the side and then acts in the same manner as an eyebrow above the 
receiving means. 
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13. The system according to claim 10, 11 or 12, characterized in 
that said autonomous device is provided .with a screen above 

at least one receiving means in the line of receiving means, said, 
absorbed attenuating undesired reflections from above and/or from 
the side and then acts in the same manner as an eyebrow above the 
receiving means. 

14. The system according to any one of the preceding claims 10 
to 13, characterized in that the most outer receiving means on 
each side of the line of said receiving means are arranged 
differently in height in relation to the remaining receiving 
means of the receiving system, 

15. The system according to any one of the preceding claims 10 
to 14, characterized in that said wave of slow propagation 
comprises a longitudinal acoustic wave. 

16. The system according to any one of the preceding claims 10 
to 14 , characterized in that said wave of slow propagation 
comprises an acoustic wave having a frequency within the 
ultrasonic range. 

17. The system according to any one of the preceding claims 10 
to 14, characterized in that said wave of slow propagation being 
transmitted for sensing obstacles proximate to said device 
comprises a short, regularly repeated pulse or alternatively a 
repeated swept pulse (chirp signal). 

18. The system according to any one of the preceding claims 10 
to 14, characterized in that said receiving comprise microphone 
elements adopted to the frequency of the wave of slow propaga- 
tion. 
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